  // 电机PID参数
    g_speed_final = 30;
    g_speed_p = 75;
    g_speed_i = 10;
    g_speed_d = 8;

    // 转向pd参数
    g_direction_p = 80;
    g_direction_d = 6;
